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Turn VCm off 
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Read in the ADC value through both Vvcm and 
VRsense paths as: ADC(Vref1) and ADC(Vref2) 
respectively 
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Apply a mall current towards the crash 
stop (Unload direction) 



Select Vvcm input to the MUX and read in the 
ADC value as: ADC(Vvcm) - ADC(Vref 1 ) 



Select VRsense input to the MUX and read in 
the ADC value as: ADC(VRsense) - ADC(Vref2) 
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Calculate Kcal value such that: 
[ADC(Vvcm)-ADC(Vref1)] - Kcal.[ADC(VRsense)-ADC(Vref2)] = 0 
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Unload 



Set Load Target Velocity as: 
V_Load_Target 
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Set Unload Target Velocity as: 
V_Unload_Target 
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Receive Vvcm & VRsense 
measurement 



Calculate back EMF, Vbemf as: 
Vbemf = (Vvcm - Vrefl) - Kcal.(VRsense - Vref2) 
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Calculate the velocity error as: 
V_Load_Target - Vbemf 



Do the loop compensation to obtain 
the desired control response and 
output control copmmand to VCM 



Wait for the next 
sample time 




Receive Vvcm & VRsense 
measurement 
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Calculate back EMF, Vbemf as: 
Vbemf = (Vvcm - Vrefl) - Kcal.(VRsense - Vref2) 



Calculate the velocity error as: 
V_Unload_Target - Vbemf 



Do the loop compensation to obtain 
the desired control response and 
output control copmmand to VCM 



Wait for the next 
sample time 




Done with the loading, Lock to 
track and continue 
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Disable VCM 
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Determine the value of the Voltage Err for 


this time period, 




Verr(n) 
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Calculate the value for the discrete control 
variable, Control(n) as: 

Control(n) = Control(n-l) + (Ki*T - Kp) * Verr 
+ Kp * Verr(n) 



Send the discrete control variable, 
Control(n), to the driver circuit, which 
compensates the velocity of the header 



Set the variables Control(n-l) and Verr(n-1) 

as: 

Control(n-l) = Control(n) 
Verr(n-l) = Verr(n) 
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End 



660 



Figure 6 



